Guest User

Untitled

a guest
May 14th, 2019
17
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 10.39 KB | None | 0 0
  1. const int stepX = 2;
  2. const int dirX = 5;
  3. const int stepY = 3;
  4. const int dirY = 6;
  5. const int enPin = 8;
  6. void setup() {
  7. pinMode(stepX,OUTPUT);
  8. pinMode(dirX,OUTPUT);
  9. pinMode(stepY,OUTPUT);
  10. pinMode(dirY,OUTPUT);
  11. pinMode(enPin,OUTPUT);
  12. }
  13. void loop() {
  14. digitalWrite(enPin,LOW);
  15. digitalWrite(dirX,LOW);
  16. for(int x = 0; x < 25000; x++) {
  17. digitalWrite(stepX,HIGH);
  18. delayMicroseconds(800);
  19. digitalWrite(stepX,LOW);
  20. delayMicroseconds(800);
  21. }
  22. delay(1000);//01
  23. digitalWrite(enPin,LOW);
  24. digitalWrite(dirY,LOW);
  25. for(int x = 0; x < 1000; x++) {
  26. digitalWrite(stepY,HIGH);
  27. delayMicroseconds(800);
  28. digitalWrite(stepY,LOW);
  29. delayMicroseconds(800);
  30. }
  31. delay(1000);
  32. digitalWrite(enPin,LOW);
  33. digitalWrite(dirX,HIGH);
  34. for(int x = 0; x < 25000; x++) {
  35. digitalWrite(stepX,HIGH);
  36. delayMicroseconds(800);
  37. digitalWrite(stepX,LOW);
  38. delayMicroseconds(800);
  39. }
  40. delay(1000);//02
  41. digitalWrite(enPin,LOW);
  42. digitalWrite(dirY,LOW);
  43. for(int x = 0; x < 1000; x++) {
  44. digitalWrite(stepY,HIGH);
  45. delayMicroseconds(800);
  46. digitalWrite(stepY,LOW);
  47. delayMicroseconds(800);
  48. }
  49. delay(1000);
  50. digitalWrite(enPin,LOW);
  51. digitalWrite(dirX,LOW);
  52. for(int x = 0; x < 25000; x++) {
  53. digitalWrite(stepX,HIGH);
  54. delayMicroseconds(800);
  55. digitalWrite(stepX,LOW);
  56. delayMicroseconds(800);
  57. }
  58. delay(1000);//03
  59. digitalWrite(enPin,LOW);
  60. digitalWrite(dirY,LOW);
  61. for(int x = 0; x < 1000; x++) {
  62. digitalWrite(stepY,HIGH);
  63. delayMicroseconds(800);
  64. digitalWrite(stepY,LOW);
  65. delayMicroseconds(800);
  66. }
  67. delay(1000);
  68. digitalWrite(enPin,LOW);
  69. digitalWrite(dirX,HIGH);
  70. for(int x = 0; x < 25000; x++) {
  71. digitalWrite(stepX,HIGH);
  72. delayMicroseconds(800);
  73. digitalWrite(stepX,LOW);
  74. delayMicroseconds(800);
  75. }
  76. delay(1000);//04
  77. digitalWrite(enPin,LOW);
  78. digitalWrite(dirY,LOW);
  79. for(int x = 0; x < 1000; x++) {
  80. digitalWrite(stepY,HIGH);
  81. delayMicroseconds(800);
  82. digitalWrite(stepY,LOW);
  83. delayMicroseconds(800);
  84. }
  85. delay(1000);
  86. digitalWrite(enPin,LOW);
  87. digitalWrite(dirX,LOW);
  88. for(int x = 0; x < 25000; x++) {
  89. digitalWrite(stepX,HIGH);
  90. delayMicroseconds(800);
  91. digitalWrite(stepX,LOW);
  92. delayMicroseconds(800);
  93. }
  94. delay(1000);//05
  95. digitalWrite(enPin,LOW);
  96. digitalWrite(dirY,LOW);
  97. for(int x = 0; x < 1000; x++) {
  98. digitalWrite(stepY,HIGH);
  99. delayMicroseconds(800);
  100. digitalWrite(stepY,LOW);
  101. delayMicroseconds(800);
  102. }
  103. delay(1000);
  104. digitalWrite(enPin,LOW);
  105. digitalWrite(dirX,HIGH);
  106. for(int x = 0; x < 25000; x++) {
  107. digitalWrite(stepX,HIGH);
  108. delayMicroseconds(800);
  109. digitalWrite(stepX,LOW);
  110. delayMicroseconds(800);
  111. }
  112. delay(1000);//06
  113. digitalWrite(enPin,LOW);
  114. digitalWrite(dirY,LOW);
  115. for(int x = 0; x < 1000; x++) {
  116. digitalWrite(stepY,HIGH);
  117. delayMicroseconds(800);
  118. digitalWrite(stepY,LOW);
  119. delayMicroseconds(800);
  120. }
  121. delay(1000);
  122. digitalWrite(enPin,LOW);
  123. digitalWrite(dirX,LOW);
  124. for(int x = 0; x < 25000; x++) {
  125. digitalWrite(stepX,HIGH);
  126. delayMicroseconds(800);
  127. digitalWrite(stepX,LOW);
  128. delayMicroseconds(800);
  129. }
  130. delay(1000);//07
  131. digitalWrite(enPin,LOW);
  132. digitalWrite(dirY,LOW);
  133. for(int x = 0; x < 1000; x++) {
  134. digitalWrite(stepY,HIGH);
  135. delayMicroseconds(800);
  136. digitalWrite(stepY,LOW);
  137. delayMicroseconds(800);
  138. }
  139. delay(1000);
  140. digitalWrite(enPin,LOW);
  141. digitalWrite(dirX,HIGH);
  142. for(int x = 0; x < 25000; x++) {
  143. digitalWrite(stepX,HIGH);
  144. delayMicroseconds(800);
  145. digitalWrite(stepX,LOW);
  146. delayMicroseconds(800);
  147. }
  148. delay(1000);//08
  149. digitalWrite(enPin,LOW);
  150. digitalWrite(dirY,LOW);
  151. for(int x = 0; x < 1000; x++) {
  152. digitalWrite(stepY,HIGH);
  153. delayMicroseconds(800);
  154. digitalWrite(stepY,LOW);
  155. delayMicroseconds(800);
  156. }
  157. delay(1000);
  158. digitalWrite(enPin,LOW);
  159. digitalWrite(dirX,LOW);
  160. for(int x = 0; x < 25000; x++) {
  161. digitalWrite(stepX,HIGH);
  162. delayMicroseconds(800);
  163. digitalWrite(stepX,LOW);
  164. delayMicroseconds(800);
  165. }
  166. delay(1000);//09
  167. digitalWrite(enPin,LOW);
  168. digitalWrite(dirY,LOW);
  169. for(int x = 0; x < 1000; x++) {
  170. digitalWrite(stepY,HIGH);
  171. delayMicroseconds(800);
  172. digitalWrite(stepY,LOW);
  173. delayMicroseconds(800);
  174. }
  175. delay(1000);
  176. digitalWrite(enPin,LOW);
  177. digitalWrite(dirX,HIGH);
  178. for(int x = 0; x < 25000; x++) {
  179. digitalWrite(stepX,HIGH);
  180. delayMicroseconds(800);
  181. digitalWrite(stepX,LOW);
  182. delayMicroseconds(800);
  183. }
  184. delay(1000);//10
  185. digitalWrite(enPin,LOW);
  186. digitalWrite(dirY,LOW);
  187. for(int x = 0; x < 1000; x++) {
  188. digitalWrite(stepY,HIGH);
  189. delayMicroseconds(800);
  190. digitalWrite(stepY,LOW);
  191. delayMicroseconds(800);
  192. }
  193. delay(1000);
  194. digitalWrite(enPin,LOW);
  195. digitalWrite(dirX,LOW);
  196. for(int x = 0; x < 25000; x++) {
  197. digitalWrite(stepX,HIGH);
  198. delayMicroseconds(800);
  199. digitalWrite(stepX,LOW);
  200. delayMicroseconds(800);
  201. }
  202. delay(1000);//11
  203. digitalWrite(enPin,LOW);
  204. digitalWrite(dirY,LOW);
  205. for(int x = 0; x < 1000; x++) {
  206. digitalWrite(stepY,HIGH);
  207. delayMicroseconds(800);
  208. digitalWrite(stepY,LOW);
  209. delayMicroseconds(800);
  210. }
  211. delay(1000);
  212. digitalWrite(enPin,LOW);
  213. digitalWrite(dirX,HIGH);
  214. for(int x = 0; x < 25000; x++) {
  215. digitalWrite(stepX,HIGH);
  216. delayMicroseconds(800);
  217. digitalWrite(stepX,LOW);
  218. delayMicroseconds(800);
  219. }
  220. delay(1000);//12
  221. digitalWrite(enPin,LOW);
  222. digitalWrite(dirY,LOW);
  223. for(int x = 0; x < 1000; x++) {
  224. digitalWrite(stepY,HIGH);
  225. delayMicroseconds(800);
  226. digitalWrite(stepY,LOW);
  227. delayMicroseconds(800);
  228. }
  229. delay(1000);
  230. digitalWrite(enPin,LOW);
  231. digitalWrite(dirX,LOW);
  232. for(int x = 0; x < 25000; x++) {
  233. digitalWrite(stepX,HIGH);
  234. delayMicroseconds(800);
  235. digitalWrite(stepX,LOW);
  236. delayMicroseconds(800);
  237. }
  238. delay(1000);//13
  239. digitalWrite(enPin,LOW);
  240. digitalWrite(dirY,LOW);
  241. for(int x = 0; x < 1000; x++) {
  242. digitalWrite(stepY,HIGH);
  243. delayMicroseconds(800);
  244. digitalWrite(stepY,LOW);
  245. delayMicroseconds(800);
  246. }
  247. delay(1000);
  248. digitalWrite(enPin,LOW);
  249. digitalWrite(dirX,HIGH);
  250. for(int x = 0; x < 25000; x++) {
  251. digitalWrite(stepX,HIGH);
  252. delayMicroseconds(800);
  253. digitalWrite(stepX,LOW);
  254. delayMicroseconds(800);
  255. }
  256. delay(1000);//14
  257. digitalWrite(enPin,LOW);
  258. digitalWrite(dirY,LOW);
  259. for(int x = 0; x < 1000; x++) {
  260. digitalWrite(stepY,HIGH);
  261. delayMicroseconds(800);
  262. digitalWrite(stepY,LOW);
  263. delayMicroseconds(800);
  264. }
  265. delay(1000);
  266. digitalWrite(enPin,LOW);
  267. digitalWrite(dirX,LOW);
  268. for(int x = 0; x < 25000; x++) {
  269. digitalWrite(stepX,HIGH);
  270. delayMicroseconds(800);
  271. digitalWrite(stepX,LOW);
  272. delayMicroseconds(800);
  273. }
  274. delay(1000);//15
  275. digitalWrite(enPin,LOW);
  276. digitalWrite(dirY,LOW);
  277. for(int x = 0; x < 1000; x++) {
  278. digitalWrite(stepY,HIGH);
  279. delayMicroseconds(800);
  280. digitalWrite(stepY,LOW);
  281. delayMicroseconds(800);
  282. }
  283. delay(1000);
  284. digitalWrite(enPin,LOW);
  285. digitalWrite(dirX,HIGH);
  286. for(int x = 0; x < 25000; x++) {
  287. digitalWrite(stepX,HIGH);
  288. delayMicroseconds(800);
  289. digitalWrite(stepX,LOW);
  290. delayMicroseconds(800);
  291. }
  292. delay(1000);//16
  293. digitalWrite(enPin,LOW);
  294. digitalWrite(dirY,LOW);
  295. for(int x = 0; x < 1000; x++) {
  296. digitalWrite(stepY,HIGH);
  297. delayMicroseconds(800);
  298. digitalWrite(stepY,LOW);
  299. delayMicroseconds(800);
  300. }
  301. delay(1000);
  302. digitalWrite(enPin,LOW);
  303. digitalWrite(dirX,LOW);
  304. for(int x = 0; x < 25000; x++) {
  305. digitalWrite(stepX,HIGH);
  306. delayMicroseconds(800);
  307. digitalWrite(stepX,LOW);
  308. delayMicroseconds(800);
  309. }
  310. delay(1000);//17
  311. digitalWrite(enPin,LOW);
  312. digitalWrite(dirY,LOW);
  313. for(int x = 0; x < 1000; x++) {
  314. digitalWrite(stepY,HIGH);
  315. delayMicroseconds(800);
  316. digitalWrite(stepY,LOW);
  317. delayMicroseconds(800);
  318. }
  319. delay(1000);
  320. digitalWrite(enPin,LOW);
  321. digitalWrite(dirX,HIGH);
  322. for(int x = 0; x < 25000; x++) {
  323. digitalWrite(stepX,HIGH);
  324. delayMicroseconds(800);
  325. digitalWrite(stepX,LOW);
  326. delayMicroseconds(800);
  327. }
  328. delay(1000);//18
  329. digitalWrite(enPin,LOW);
  330. digitalWrite(dirY,LOW);
  331. for(int x = 0; x < 1000; x++) {
  332. digitalWrite(stepY,HIGH);
  333. delayMicroseconds(800);
  334. digitalWrite(stepY,LOW);
  335. delayMicroseconds(800);
  336. }
  337. delay(1000);
  338. digitalWrite(enPin,LOW);
  339. digitalWrite(dirX,LOW);
  340. for(int x = 0; x < 25000; x++) {
  341. digitalWrite(stepX,HIGH);
  342. delayMicroseconds(800);
  343. digitalWrite(stepX,LOW);
  344. delayMicroseconds(800);
  345. }
  346. delay(1000);//19
  347. digitalWrite(enPin,LOW);
  348. digitalWrite(dirY,LOW);
  349. for(int x = 0; x < 1000; x++) {
  350. digitalWrite(stepY,HIGH);
  351. delayMicroseconds(800);
  352. digitalWrite(stepY,LOW);
  353. delayMicroseconds(800);
  354. }
  355. delay(1000);
  356. digitalWrite(enPin,LOW);
  357. digitalWrite(dirX,HIGH);
  358. for(int x = 0; x < 25000; x++) {
  359. digitalWrite(stepX,HIGH);
  360. delayMicroseconds(800);
  361. digitalWrite(stepX,LOW);
  362. delayMicroseconds(800);
  363. }
  364. delay(1000);//20
  365. digitalWrite(enPin,LOW);
  366. digitalWrite(dirY,LOW);
  367. for(int x = 0; x < 1000; x++) {
  368. digitalWrite(stepY,HIGH);
  369. delayMicroseconds(800);
  370. digitalWrite(stepY,LOW);
  371. delayMicroseconds(800);
  372. }
  373. delay(1000);
  374. digitalWrite(enPin,LOW);
  375. digitalWrite(dirX,LOW);
  376. for(int x = 0; x < 25000; x++) {
  377. digitalWrite(stepX,HIGH);
  378. delayMicroseconds(800);
  379. digitalWrite(stepX,LOW);
  380. delayMicroseconds(800);
  381. }
  382. delay(1000);//21
  383. digitalWrite(enPin,LOW);
  384. digitalWrite(dirY,LOW);
  385. for(int x = 0; x < 1000; x++) {
  386. digitalWrite(stepY,HIGH);
  387. delayMicroseconds(800);
  388. digitalWrite(stepY,LOW);
  389. delayMicroseconds(800);
  390. }
  391. delay(1000);
  392. digitalWrite(enPin,LOW);
  393. digitalWrite(dirX,HIGH);
  394. for(int x = 0; x < 25000; x++) {
  395. digitalWrite(stepX,HIGH);
  396. delayMicroseconds(800);
  397. digitalWrite(stepX,LOW);
  398. delayMicroseconds(800);
  399. }
  400. delay(1000);
  401. digitalWrite(enPin,LOW);
  402. digitalWrite(dirY,HIGH);
  403. for(int x = 0; x < 21000; x++) {
  404. digitalWrite(stepY,HIGH);
  405. delayMicroseconds(800);
  406. digitalWrite(stepY,LOW);
  407. delayMicroseconds(800);
  408. }
  409. delay(1000);
  410. }
Add Comment
Please, Sign In to add comment